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© Apparatus for and method of controlling positioning of movable member. 



© A movable member positioning control appara- 
tus includes a movable member (9, 150) which is at 
least two-dimensionally movable by actuators and in 
the apparatus a system is employed in which a 
relative position of said movable member to a work- 
ing position of a work object is sensed by contact of 

3 a contact segment of said movable member with 
said working position and a position of said movable 
r— member is corrected. The apparatus further includes 
0>a control section (30) for controlling said actuators 
^such that force is applied to said movable member 
CO for a predetermined time period from when the con- 
SStact is sensed in a direction opposite to a moving 
direction of said movable member when the contact 
©is sensed, and wherein said second control means 
j^(30) is operated when the contact is sensed. 
UJ 
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APPARATUS FOR AND METHOD OF CONTROLLING POSITIONING OF MOVABLE MEMBER 



The present invention relates to an apparatus 
for and a method of controlling positioning of a 
movable member such as a hand of an industrial 
robot and more particularly, to the apparatus and 
the method suitable for an automatic welding robot. 

An industrial robot, in which a movable mem* 
ber can be moved into an arbitrary direction and 
positioned at an arbitrary position by using a plural* 
ity of actuators which are electrically controllable, is 
widely utilized in an automatic welding apparatus. 
In positioning control of the movable member such 
as a hand of the industrial robot, there is a problem 
in precision of the positioning control, as a matter 
of course. In addition, when the positioning control 
is applied to the automatic welding apparatus, there 
is another problem in displacement between a work 
(to be welded) and a welding torch supported by 
the hand of the robot That is, even though the 
hand of the robot is positioned with high precision, 
good welding results cannot be obtained if the work 
is displaced from a designated position. 

As one of examples to dissolve such problems, 
a proposal tn JP-A-54-15441 is well known. In such 
a conventional technique as shown in JP-A-54- 
15441, a contact segment is supported by a mov- 
able member such as a hand of a robot This 
contact segment is caused to contact with a work 
prior to a job such as a welding operation. The 
position of the work is detected by sensing the 
contact of the contact segment with the work and 
the correction is performed in the position control 
in accordance with the detected work position. In 
this example, a welding wire projected from a weld- 
ing torch is used as the contact segment While a 
predetermined voltage is applied between the- 
welding wire and the work, the welding torch is 
moved in a direction at a predetermined speed. 
When the wire contacts with the work, a conductive 
path is formed between the welding wire and the 
work and current flows from the wire to the work. 
The position of the work is sensed from the posi- 
tion of the welding torch by sensing the current 
flowing through the welding wire. 

In the above conventional technique, however, 
faster movement of the movable member is not 
taken account for in the sensing operation of the 
work position. Therefore, the sensing operation of 
the work position requires a long time, and hence a 
problem in lowering of the job speed occurs. 

The problem in the conventional technique will 
be described below in detail. 

Fig. 1 is a block diagram showing an arrange- 
ment of a position control system usually used in a 
conventional automatic welding apparatus in which 
a robot is employed. In the figure, numeral 64 



indicates a motor as an actuator for moving a hand 
of the robot A position command calculating sec- 
tion 60 calculates a position of the hand to be 
moved in detection of the work position every 
5 predetermined period of time. Numeral 68 indicates 
a position command signal representing the posi- 
tion thus calculated. A signal representing differ- 
ence in level between the position command signal 
68 and a current position signal 74 sensed by a 

to position sensor 66 is amplified by an amplifier 61 
to obtain a speed command signal 69. Difference 
in level between the speed command signal 69 and 
a current speed signal 73 sensed by a speed 
sensor 65 is determined and an amplifier 62 am- 
is plifies a signal representing the difference to obtain 
an acceleration command signal 70. 

Assuming that mass of the hand or the like 
moved by the motor 64 is not changed, the accel- 
eration command signal 70 can be regarded as a 

20 torque command signal for the motor 64. As a 
result, the acceleration command signal 70 can be 
also regarded to be equal to a current command 
signal for the motor 64. 

An amplifier 63 amplifies the acceleration com- 

25 mand signal 70 to obtain a current signal 71 and 
the signal 71 is supplied to the motor 64 to move 
the hand. At this time, the amplifier 63 is subjected 
to a negative feed-back operation by a current 
feed-back signal 72 to have the predetermined 

30 precision. 

A rotation speed and a rotation angle of the 
motor 64 are sensed by the speed sensor 65 and 
the position sensor 66, respectively. As described 
above, the rotation speed and the rotation angle 

35 are used to determine differences with values com- 
manded by various control commands. Thus, the 
negative feed-back operation is applied to the posi- 
tioning control, with the result that high precision 
control can be achieved. 

40 Numeral 67 indicates a contact sensing unit 
using the contact segment as described above and 
a contact signal from the unit 67 is supplied to the 
position command calculating section 60. 

In the above system, circuits from the amplifier 

46 61 to the motor 64 are often constituted by analog 
circuits and independently provided for the robot 
for each control axis. 

Figs. 2A, 2B and 2C are graphs showing oper- 
ations upon sensing the position of the robot by the 

so contact segment in the system shown in Fig. 1. 
Figs. 2A, 2B and 2C show changing states of a 
position X of the torch (hand), a speed value of the 
torch, and an acceleration (torque) value a of the 
torch. An axis of abscissa of each graph indicates 
time. Note that the position X in Fig. 2A is on a 
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sensing path. 

Assuming that the work as an object whose 
position is to be detected is on a position Xw in Fig. 
2A. the position command signal 68 is calculated in 
a step manner, as shown in the figure. 

A displacement value AX between a position 
commanded by the position command signal 68 
and an actual torch position represented by the 
current position signal 74 represents a speed com- 
mand signal. Therefore, at this time, the speed 
command signal 69 is as shown in Fig. 2B. Further, 
the difference between a value commanded by the 
speed command signal 69 and an actual torch 
speed value represented by the current speed sig- 
nal 73 represents a torque command signal. There- 
fore, the torque command signal 71 is as shown in 
Fig. 2C. 

In this manner, the torch is moved at a pre- 
determined speed (a sensing operation speed) and 
the wire contacts with the work to be welded at the 
position P. At this time to. the position commanded 
by the position command is Q and the commanded 
position Q is displaced from the position P by a 
displacement value AD proportional to the sensing 
operation speed V SI as shown in Fig. 2A. For this 
reason, even if the position command is stopped at 
the time to when the contact is sensed, the torch 
further moves from the current position P toward 
the position Q commanded by the position com- 
mand, i.e., by the displacement value AD from the 
work position. . 

When the sensing operation speed is V Sf the 
displacement value AD can be expressed by the 
following equation: 
V, = G'AD 
Therefore, 
AD = V^'G 

where G is called a loop gain and determined by 
gains of the amplifiers 61 to 63. 

In a position sensing system using the contact 
segment when the displacement value AD is great, 
the contact segment (the wire in this case) is bent 
Therefore, the subsequent position sensing opera- 
tion cannot be performed. 

The loop gain G is determined by the char- 
acteristics of the automatic welding apparatus and 
it is well known that the vibration occurs and the 
stable positioning control cannot be performed, 
when the gain G is too great Hence, the sensing 
operation speed V s 
AK £ AD = V* G 
Therefore, 
V s 5 G*AK 

where AK is a maximum value, to which the torch 
can be inertially moved without plastic deformation 
of the wire, and is usually jabout 0.5 to 1 mm. 

The loop gain is different for every apparatus. 
In order to obtain the loop gain of 20 in a large 



scale apparatus, more expensive motor is needed. 
Assuming that Ak = 1 mm and G = 20, 
V s S 20 mm/sec 

When the displacement value of the work is i20 

5 mm, the time necessary for the position sensing 
operation is more than 2 sec. 

Information of the sensed position is one-di- 
mensional in this position sensing system. There- 
fore, as required in a general automatic welding 

io apparatus, in order to sense a three-dimensional 
position of the work to be welded, the position 
sensing operations must be performed in three 
directions, i.e., three times. If there are many weld- 
ing positions, the position sensing operations must 

*5 be performed by the number of welding positions. 
As a result a lot of time is taken for the position 
sensing operation in the conventional technique, 
thereby resulting in lowering of the job speed. 
The object of the present invention is to pro- 

20 vide a movable member positioning control method 
and apparatus, in which there is no possibility that 
a contact segment such as a wire is deformed 
even if the position sensing operation speed is 
increased, and in which the time required for the 

25 position sensing operation can be sufficiently de- 
creased. 

The above object can be achieved, according 
to one of the features of the present invention, by 
controlling an actuator for moving a movable mem- 

30 ber at the time when the contact of the wire with 
the work is sensed, such that acceleration is ap- 
plied to the movable member in a direction op- 
posite to that of acceleration applied to the mov- 
able member before the contact is sensed. 

35 When the contact is sensed, the acceleration is 
applied to the movable member in the direction 
opposite to the acceleration direction applied to the 
movable member before the contact is sensed. 
Therefore, force negating inertia force is operated 

40 to the movable member so that sufficient braking 
power can be applied to the movable member 
without providing a separate and independent brak- 
ing unit. Therefore, the inertially moving distance of 
the movable member can be easily held within a 

45 predetermined distance even if the sensing speed 
is increased, and thereby the time required for the 
position sensing operation can be sufficiently short- 
ened. 

The present invention will be apparent from the 
so following detailed description taken in conjunction 
with the accompanying drawings, in which: 

Fig. 1 is a functional block diagram showing 
a control operation in a conventional example; 

Figs. 2A, 2B and 2C are graphs for explain- 
55 ing the control operation in the conventional exam- 
ple; 

Fig. 3 is a block diagram showing an ar- 
rangement of an embodiment when the present 
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invention is applied to an industrial robot such as 
an automatic welding apparatus; 

Fig. 4 is a circuit block diagram showing an 
arrangement of a movable member positioning 
control apparatus according to an embodiment of 
the present invention; 

Fig. 5 is a block diagram of a sensor mecha- 
nism which can be applied to the movable member 
positioning control apparatus according to the 
present invention; 

Fig. 6 is a diagram for explaining the posi- 
tion sensing operation; 

Fig. 7 is a functional block diagram showing 
a control operation in the movable member posi- 
tioning control apparatus according to the embodi- 
ment of the present invention; 

Figs. 8A, 8B and 8C are graphs for explain- 
ing the control operation in the embodiment of the 
present invention; and 

Figs. 9 to 12 are flow charts for explaining 
the control operation in the embodiment of the 
present invention. 

An apparatus for and a method of controlling 
positioning of a movable member will be described 
in detail based on embodiments shown in accom- 
panying drawings. 

Fig. 3 is a block diagram showing an entire 
arrangement of an embodiment of an automatic 
welding apparatus as an industrial robot to which 
the present invention is applied. In the figure, a . 
robot control unit 1 controls the entire apparatus. A 
welder 2 generates a current and a voltage for 
welding in response to a command from the unit 1. 
A sensor control unit 3 applies a high voltage to a 
welding wire in response to a command from the 
unit 1 and informs the unit 1 that the wire contacts 
with a work. A main body 4 of the robot is con- 
stituted to have six axes. Each axis is driven by a 
motor (an actuator) to which current is supplied 
from the unit 1. A rotation angle of each motor is 
sensed by an encoder and informed to the unit 1 . 

A robot operation box 5 is provided with a 
mode switch for switching a teaching mode and an 
execution mode, start and stop buttons for starting 
and stopping the robot, and the like. A robot teach- 
ing unit 6 is used for teaching the robot operations 
such as a position sensing operation and a welding 
operation. For this purpose, on the panel of the unit 
6 are provided keys such as operation keys for 
manually moving each axis of the robot and a key 
for teaching a position of the robot 

A wire delivering unit 7 delivers the welding 
wire in response to a command from the welder 2. 
Numeral 8 indicates a wire supply unit. Numeral 9 
indicates a welding torch 9 and the welding wire 90 
is delivered from the tip of the torch 9. Numeral 
150 indicates a hand for supporting the welding 
torch 9. Numeral JO indicates a base which is 



connected to ground. Numeral 11 indicates the 
work as an object to be welded. The work is often 
located on the base 10 with a displacement from a 
designated position. Hence, in the embodiment, the 
5 displacement of the work 11 is sensed and a 
vertical plate is welded to a base plate in according 
to the displacement. 

Fig. 4 is a block diagram showing inside hard- 
ware of the robot control unit 1. In Fig. 6. a main 

io CPU section 20 controls periphery units and a 
sequence of operations of the entire apparatus. 
Values commanded by commands through a posi- 
tion command are calculated by the section 20 and 
the commands representing the values are gen- 

/5 erated. A CPU-A 21 performs control and oper- 
ations in the section 20. An initial job program to 
be executed by the CPU-A 21 when the apparatus 
is turned on is stored in a ROM-A 22. Job pro- 
grams transferred from a bulk memory 27 and 

20 intermediate results of calculations are stored in a 
RAM- A 23. A communication interface (LF) 24 has 
communication ports of two channels, one of which 
is connected to the robot operation box 5. the other 
being connected to the robot teaching unit 6. The 

25 CPU-A 21 can input states of the keys or the 
pushed buttons of the unit 6 through the interface 
24 and supply commands to each unit 

A welder interface fi/F) 25 interfaces an arc 
ON/OFF command, a voltage command upon an 

30 arc ON state, and a wire delivering speed com- 
mand from the CPU-A 21 to the welder 2. Numeral 
26 indicates a sensor interface-A (i/F-A). through 
which the CPU-A commands a contact sensing 
operation to the sensor control unit The bubble 

35 memory 27 is non-volatile. Taught position informa- 
tion and many of programs to be executed by the 
CPU-A 21 are stored in the memory 27. When the 
apparatus is turned on, the stored information is 
transferred to the RAM-A 23 by execution of the 

40 initial program in the ROM-A 22 by the CPU-A 21. 
The CPU-A 21 exchanges data with each unit 
through a bus 28 in the main CPU section. A duai- 
port RAM (DPRAM) 29 can be accessed by the 
CPU-A 21 and a CPU-B (to be described later) and 

45 exchange of data between both CPUs is performed 
through the RAM 29. 

A servo CPU section 30 receives a position 
command from the main CPU section 20, cal- 
culates values to be commanded by a speed com- 

so mand, a torque command, and the like, and out- 
puts commands representing the values to a servo 
amplifier 39 (to be described later). The CPU-B 31 
performs operations and controls the entire servo 
CPU section 30. A timer 32 generates an interrupt 

55 to the CPU-B 31 every period of time, which is 
predesignated by the CPU-B 31. A sensor 
interface- B (i/F-B) 33 receives from the sensor con- 
trol unit 3 a signal representing whether or not the 
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wire contacts with the work and transfers the signal 
to the CPU-B 31. A RAM-B 34 stores intermediate 
results of the operations by the CPU-B 31. A ROM- 
B 35 stores a program describing algorithm to be 
executed by the CPU-B 31. A D/A converter 36 
receives a digital signal representing the torque 
command from the CPU-B 31 and converts it to an 
analog signal (voltage) to supply the converted 
analog signal to the servo amplifier 39. The D/A 
converter 36 can perform the conversion operations 
for six axes. A counter 37 counts pulses transmit- 
ted from an encoder section 50 for each axis to 
measure a current rotation angle value of the axis 
and outputs the current angle value to the CPU-B. 

A motor section 40 as driving means is moun- 
ted on the robot main body 4. The motor section 
includes six motors (actuators) Ml to MS for driving 
the six axes of rotation, above-elbow, below-elbow, 
bend, swing and twist operations. The encoder 
section 50. which is mounted on the robot main 
body 4. includes six encoders El to E6. each of 
which generates pulses in correspondence with a 
rotation angle value of a corresponding motor. Note 
that all the sections in Fig. 4 except for the motor 
section 40 and the encoder section 50 are included 
in the robot control unit 1. 

Next a contact sensing operation of the sensor 
control unit 3 will be described below with refer- 
ence to Fig. 5. An AC generator 47, a transformer 
48, a current .sensor 49 and the like are included in 
the sensor control unit 3. The contact sensing 
operation is performed as described below. 

First, the AC generator 47 generates a high AC 
voltage in response to a contact sense start com- 
mand signal received from the sensor interface-A 
26 and the high voltage is supplied to a welding 
circuit through the transformer 48. When the wire 
90 at the tip of the torch 9 contacts with the work 
11, an AC closed loop is formed by the transformer 
48. the wire 90 at the tip of the torch 9, the work 
11, the work base 10, a bypass capacitor Ci in the 
welder 2, and the current sensor 49 to How an AC 
current in the loop. The AC current is sensed by 
the current sensor 49 and it is informed to the 
sensor interface-B 33 that the wire contacts with 
the work. Note that a value of the AC current is 
limited to a minimum value which is required to 
sense the contact without influence on the human 
body for the purpose of safety. 

Next, an operation of the entire apparatus will 
be described below focusing on the CPU-A 21 with 
reference to Fig. 6. 

First the mode switch on the robot operation 
box 5 is operated to set the teaching mode. Each 
axis of the robot is moved by means of the teach- 
ing unit 6 such that the tip of the wire reaches a 
position Pi . Then, the teaching button is pushed so 
that the position Pi is memorized in the robot. At 



the same time, it is input that the position Pi is a 
sense start position. Subsequently, the robot is 
moved such that the wire tip reaches a position P2 
on the work 11 in the teaching mode and the 

5 position P 2 is taught as a sense position to the 
robot. Next a refuge position Pa and a welding 
start position P4 are taught. Thereafter, welding 
positions and a welding end position (these are not 
shown) are sequentially taught. 

10 Next, the mode switch is switched to set the 
execution mode. In the execution mode, the CPU-A 
21 sequentially reads out the taught positions and 
job conditions, and outputs commands to the pe- 
riphery units and position commands, for moving 

15 the robot to the positions, to the CPU-B 31 in 
accordance with the read out positions and con- 
ditions to perform the welding job. Note that the 
CPU-A 21 interpolates a path to a next position 
every predetermined time period to generate a 

20 position command, and outputs the position com- 
mands representing the interpolated path to the 
CPU-B 31. 

Now, assume that the work is shifted from the 
position 11 shown by the broken line to location 

25 1l' shown by the solid line in the execution mode. 

The CPU-A 21 moves the robot to the position 
Pt while interpolates the path to the position Pi as 
described above. Since the position Pi is the 
sense start position, the CPU-A 21 outputs the 

30 contact sense start command to the sensor control 
unit 3. In addition, the CPU-A 21 commands the 
CPU-B 31 to be set in a contact monitoring state. 
Then, the CPU-A 21 moves the robot toward the 
position P2 while interpolates the path to the work. 

35 until a contact signal is received from the CPU-B 
31. When the contact signal is received from the 
CPU-B 31, the CPU-A 21 receives a current posi- 
tion value P from the CPU-B 31 and outputs the 
current position value P as the position command 

40 to the CPU-B 31 again. That is, if described with 
reference to Fig. 8A to be described in detail later, 
a position commanded by the position command is 
changed from a position Q to the position P. 

The displacement value. S between the taught 

45 position P 2 and the sensed position P is obtained 
from the following equation: 
S = P - P 2 

Next, the robot is moved to the refuge position P 3 . 
When the robot is to be moved to the welding start 
50 position Pt, the CPU-A 21 calculates a position 
?\ instead of the position P* from the following 
equation by using the displacement value S and 
interpolates the path to the position P*: 
Pi = P* + S 

55 Thus, the job is proceeded for the subsequent 
positions displaced by the displacement value S. 

In this manner, the displacement value is 
sensed and the job is performed in accordance 
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with the sensed displacement value. 

Next, the contact sensing operation (operation 
from the position Pi to the position P) by the servo 
CPU section 30 as a main portion of the present 
invention will be described below, focusing on con- 
trol of the CPU-B. Fig. 7 is a functional block 
diagram for explaining position control by the CPU- 
B31. 

First a usual operation, i.e.. an operation when 
the contact signal 80 is not generated from the 
sensor interface-B 33. will be described. 

A value represented by a current position sig- 
nal 59 from the counter 37 is subtracted from a 
value commanded by the position command 54 
transmitted from the main CPU section 20 through 
the dual-port RAM 29 and the speed command is 
obtained as the subtracted result. A signal repre- 
senting the speed command is supplied to a con- 
tact processing section 30A. When the contact 
signal 80 is not received, the section 30A outputs 
the received speed command signal with no cor- 
rection as the speed command signal 55. A signal 
from the counter 37 representing the current posi- 
tion 59 is differentiated by a differentiation process- 
ing section 30C and a signal representing a current 
speed value 58 is obtained as a result of the 
differentiation of the signal. 

The current speed value 58 is subtracted from 
a value commanded by the speed command 55 
and a torque command representing the subtracted 
result is obtained. A signal representing the torque 
command is supplied to the OA converter 36 
through a limiter 30B and converted into a current 
command signal (an acceleration command signal) 
there. The current command signal is amplified by 
the servo amplifier 39 and a current signal 57 is 
obtained. The current signal is supplied to the 
motors Mi 40, which move the hand. At this time, 
the servo amplifier is subjected to a negative feed- 
back operation by a current feed-back signal in 
order to obtain desired precision. 

Next, an operation when the contact of the wire 
with the work is sensed by the sensor control unit 3 
and the contact signal 80 is generated will be 
described below. 

When the contact signal 80 is received, the 
contact processing section 30A generates the 
speed command representing a maximum speed 
which can be provided by the section 30A in a 
direction opposite to that of the speed command 
supplied from the CPU-A. As a result the torque 
command in the following stage has a very great 
value in a decelerating direction. For this reason, if 
the torque command is output to the servo am- 
plifier and the motors without attenuation, there is 
the possibility that the amplifier and the motors are 
damaged. Therefore, a torque value commanded 
by the torque command is limited by the limiter 



30B to a maximum value, up to which the motor 
can output; and the torque command signal repre- 
senting the limited torque value is output to the 
servo amplifier 39. 

5 The section 30A monitors the current speed 

value signal 58 supplied from the differentiation 
processing section 30C. When the value repre- 
sented by the signal 58 is substantially equal to 
zero or it represents that the direction of the speed 

w is opposite to that of the contact sensing operation, 
the section 30A stops outputting the speed com- 
mand representing the maximum speed value. That 
is. the servo CPU section 30 outputs the torque 
command representing the maximum torque value 

is in the decelerating direction for a period from the 
time when the contact signal is received to the time 
when the current speed value is substantially equal 
to zero or represents a direction opposite to the 
contact sensing direction. 

20 The states of the above signals will be de- 
scribed below with reference to the Figs. 8A, 8B 
and 8C. Figs. 8A, 8B and 8C are graphs showing 
the position, the speed, and the acceleration, simi- 
lar to Figs. 2A. 2B and 2C. respectively. Each 

25 horizontal axis indicates time. More specifically, 
Fig. 8A shows the position command signal 54 and 
the current position signal 59, Fig. 8B the speed 
command signal 55 and the current speed signal 
58, and Hg. 8C the torque command signal 57. 

30 Assuming that the work is at the position 11 ' 
shown in Fig. 6 as a position X w , the contact is 
sensed at the position P (at the time to). At this 
time, as shown in Fig. 8B. the speed command 
signal 55 is set to be -V^ for a period from the 

35 time to to the time tt by the contact processing 
section 30 A. As a result the torque command 
signal 57 is also set to be -a^*, as shown in Fig. 
8C. In this manner, as shown in Fig. 8B, the current 
speed signal 58 is abruptly decelerated, compared 

40 to Figs. 2A, 2B and 2C. This decelerating state is 
kept until time ti when the current speed signal 
becomes substantially zero. The position command 
is negated for a period from the time to to time ti 
but the main CPU section 20 has output the sec- 

46 ond position Xw as the position command until time 
tt. 

Thus, in the embodiment, the control can be 
performed such that the robot inertialiy moves only 
the short distance AOi , as shown in Fig. 8A. 

so Next let's calculate the sensing speed V s . In 
the control system in which the loop gain G is 
about 20, acceleration of about 0.5g can be gen- 
erally generated. Therefore, this acceleration is 
used as a condition. 

55 AK £ ADi = (1/2)(V|/a) 
Therefore 

As described above, if it is assumed that AK = 1 
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mm and a = 0.5g = 0.5 x 9800 mm/sec, 
V s S 99.0 mm/sec 

Therefore, in this case, the contact sensing opera- 
tion can be performed five times as fast as in a 
conventional technique. As a result, the sensing 
time is only about 1/5. thereby resulting in remark- 
able decrease of the job time. 

Next the control by the CPU-B 31 will be 
described below in detail. Fig. 9 is a flow chart 
showing a timer interrupt processing operation 100. 
The processing is performed in response to an 
interrupt which is generated every predetermined 
period of time by the timer 32. 

In step 101. a time counter is incremented by 
"1". In step 102, a count of the time counter is 
checked to see if it indicates a torque processing 
period. When it indicates the torque processing 
period, the torque processing operation is per- 
formed in step 103. 

In step 104. similarly, the count is checked to 
see if it indicates a speed processing period. When 
it indicates the speed processing period, the speed 
processing operation is performed in step 105. The 
torque period is shorter than the speed period. 

Fig. 10 shows the torque processing operation 
103 in detail. In step 111, a current value 0 C is first 
read into the counter 37. The current value 0 C is a 
6-dimensionaJ vector value and has current values 
of the axes as components, 

0C = (*1© 02O *3C. *4C. *5C. *6C) 

In step 1 12, a differential value i.e., a difference 
value because digital processing is performed in 
the embodiment, is calculated. This step corre- 
sponds to the operation of the differentiation pro- 
cessing section 30C in Rg. 7. Data Bqb is the 
current value in a previous cycle and operation is 
performed with respect to each of the axes 1 to 6. 
If not described particularly, the operation is per- 
formed with respect to each axis. 

In step 113, the current value 0c is written into 
the previous cycle current value 0cb- In step 114, a 
value commanded by the torque command is cal- 
culated. W and W c are values represented by the 
speed command and the current speed (signals 55 
and 58 in Fig. 7), respectively, and At T is a scholar 
value and represents the torque processing period. 

In steps 1 15 to 1 18, a limiter processing opera- 
tion corresponding to the operation of the limiter 
30B is performed. Data T MAX is a maximum allowa- 
ble torque value. In step 115. this value is com- 
pared with a value commanded by the torque com- 
mand T. The comparison operation is performed 
for each torque component When at least one of 
the torque components exceeds the value Tmax. an 
operation of step 116 is performed. The operation 
in step 116 has been described simply. However, 
actually, the following calculations are performed: 
T - (Ti,T 2 .T3.T4.T 5 ,T6) (1) 



T x = max (T.) (i =M to 6) (2) 

f = (Tmaxx/Tx)- T (3) 

where Tmaxx is a maximum torque value of the X-th 

axis and T x is a maximum value among the torque 

5 components. Equation (2) is for determining the 
maximum value T x . In calculation of step 116, all 
the torque components are reduced at the same 
ratio such that the maximum value of a component 
falls within the predetermined maximum torque val- 

to ue. 

In the following step 117. the operation similar 
to that in step 115 is performed. That is, a check- 
ing operation for a minimum torque value is per- 
formed, and when any one of the components is 

;s smaller than -Tmax> the flow advances to step 118. 
The operation in step 1 18 is similar to that in step 
116 and performed as follows: 
T x = min (T«) (i = 1 to 6) (4) 
T = -TTmaxx'TxJT (5) 

20 This limiter processing operation can prevent an 
excessively high torque command from being gen- 
erated so that the motors and the robot are damag- 
ed. 

In step 119. the torque command is output to 

25 the D/A converter 36. Thus, each motor generates 
a torque value in correspondence with the com- 
mand value T. 

Fig. 1 1 shows the speed processing operation 
105 in detail. In step 121, the speed command W 

30 is first calculated. Here, data e, which is a position 
command written in the dual-port RAM 29 by the 
CPU-A 21, corresponds to the signal 54 in Fig. 7, 
data 0 C is read out in step 111 in the torque 
processing operation, and AW is a period of time of 

35 the speed processing operation. 

Next, the contact sensing processing operation 
122 is performed, which will be described later. In 
step. 123, the speed command W is written in W B , 
which is the speed command in the previous cycle 

40 and used in step 122. Finally, in step 124, W is 
output to the torque processing operation 114. 

Rg. 12 shows the contact sensing processing 
operation 122 which corresponds to the operation 
of the contact processing section 30A in Fig. 7. 

45 In step 131, it is determined whether or not the 
contact monitoring state is set This state is set by 
the CPU-A 21 for the contact sensing operation. 
When the contact monitoring state is not set. the 
contact sensing processing operation is completed. 

so When the contact monitoring state is set it is 
determined in step 132 whether or not the contact 
signal is supplied to the sensor interface-B 33. 
When the signal is supplied to the interface-B 33, 
the contact of the wire with the work is informed to 

55 the CPU-A 21 in step 133. This is achieved by 
writing data representing the contact signal in the 
dual-port RAM 29 by the CPU-B 31. In step 134, 
the contact signal is cleared. In this manner, the 
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operations from step 133 to step 137 are per- 
formed once when the contact is sensed. 

In step 135. the sensing operation direction for 
each axis is stored. W B is a value commanded by 
the previous cycle speed command in step 123. 5 
Data A includes components for six axes and each 
component has " + 1" or "-1" in accordance with a 
rotating direction of a corresponding axis. In step 
136. the speed command is replaced by a maxi- 
mum allowable value (W MAX ) in a direction (-A) w 
opposite to the contact sensing operation direction. 

The above steps are briefly described but in 
order to keep a ratio of speed values for axes, the 
following operations are performed: 
W = fWt . W 2 . W 3 . W*. W s . W 6 ) (6) is 
W x = max (|W,|) (i a 1 to 6) (7) 
W = -A*(W MAX *Wx)' w (8) 
where Wmaxx is a maximum speed value for x-th 
axis and the maximum speed value W MAX is as- 
signed to a greatest speed component. 20 

Next in order to keep this state, a contact 
output state is set to be ON in step 137. The 
processing operations from step 133 to step 137 
are performed at the time to in Figs. 8A, 8B and 8C 
and represents the maximum deceleration com- 25 
mand to the motors, as apparent from the limiter 
processing operation of the torque processing op- 
eration. 

When it is determined in step 132 that the 
contact signal is not received, whether or not the jo 
contact output state is set is determined in step 
138. When the state is set to be ON. it is deter- 
mined in step 139 whether or not deceleration 
processing operation is completed. Here, data A 
represents the contact sensing operation direction, as 
and W c represents the current speed value. That 
is, it is checked whether or not the current speed 
value is substantially zero or whether or not the 
direction of the current speed is opposite to the 
contact sensing operation direction. In step 139, 40 
answer "Yes" is obtained when all the components 
for six axes satisfy the above relation. 

When it is determined in step 139 that the 
deceleration processing operation is not completed, 
the speed command W is rewritten by the previous 45 
cycle speed command W B (= -A*W MA x) in step 
142. As a result, the maximum speed command is 
kept from the time to to the time tt in Figs. 8A, 8B 
and 8C in an opposite direction to the contact 
sensing operation direction. so 

When it is determined in step 139 that the 
deceleration processing operation is completed, the 
speed command W calculated in the speed pro- 
cessing operation is remained output in step 140. 
Subsequently, in step 141 the contact output state 55 
is set to be OFF. Therefore, the processing oper- 
ations in steps 140 to 141 are performed at the 
time ti in Figs. 8A. 8B and 8C. 



When it is determined in step 138 that the 
contact output state is not set to be ON, the 
processing operation is immediately completed. 

By performing the above processing oper- 
ations, the maximum deceleration processing op- 
eration can be performed immediately when the 
wire contacts with the work, so that the inertially 
moving robot can be stopped at a shorter distance 
than usual. In this embodiment, since the robot can 
be stopped at the short distance even if the contact 
sensing operation speed value is great, the contact 
sensing operation speed value can be increased, 
and thereby decreasing the sensing operation time. 

In addition, the torque command is subjected 
to the limiter processing operation. Therefore, the 
motor and the like can be protected. 

Further, since the current value for sensing the 
contact is limited, the safety can be obtained with- 
out decreasing the sensitivity. 

Note that the special processing operation for 
stopping the robot upon the contact of the wire with 
the work is included in the processing operation for 
calculating the speed command in this embodi- 
ment. However, the special processing operation 
can be included in another processing operation 
and the present invention, therefore, is not limited 
due to a portion where the special processing 
operation is included. 

in addition, the special processing operation 
can be realized regardless of a system of a sensor 
for sensing the contact For example, a light switch 
for sensing the contact by cutting off a light path 
may be used. As should be apparent, the present 
invention can be realized regardless of the system 
of the sensing means if the contact can be sensed 
by the sensing means. 

According to the present invention, a distance 
of the movable member inertially moving from a 
position when the contact with portions of the work 
to be worked is sensed by a contact sensor to a 
position when the movable member is stopped can 
be kept short. Therefore, the time required for 
sensing the contact can be sufficiently short by 
increasing the sensing operation speed. When the 
present invention is applied to the automatic weld- 
ing apparatus utilizing the industrial robot, the job 
efficiency can be easily increased at low cost. For 
example, in one example to which the present 
invention is applied, the sensing operation less 
than 1/5 of that in a conventional technique can be 
easily obtained. 



Claims 

1. A method of controlling positioning of a 
movable member, comprising: 
a first step of moving said movable member toward 
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a work object: and 

a second step of sensing that said movable mem- 
ber contacts with said work object, 
characterized by further comprising a third step of 
applying acceleration to said movable member in a 
direction opposite to a moving direction of said 
movable member in said first step when it is 
sensed that said movable member contacts with 
said work object 

2. A method according to Claim 1, character- 
ized in that said third step further comprises a step 
of sensing that a speed of said movable member is 
substantially 0 or negative and stopping applying 
the acceleration to said movable member. 

3. A method according to Claim 1, character- 
ized by further comprising the steps of: 
generating a position of said work object as a 
position command when it is sensed that said 
movable member contacts with said work object; 
and 

stopping said movable member at a position com- 
manded by the position command when it is 
sensed that the speed of said movable member is 
substantially 0 or negative. 

4. A method according to Claim 1. character- 
ized in that said movable member has a contact 
segment for sensing contact with said work object 

5 A method according to Claim 4. character- 
ized in that said movable member is a hand for 
supporting a welding torch and said contact seg- 
ment is a welding wire delivered from said welding 
torch. 

6. A method of controlling a position of a 
movable member by a control unit comprising: 

a first step of teaching said control unit a reference 
position; 

a second step of moving said movable member 
toward a work object; 

a third step of sensing that said movable member 
contacts with said work object and 
a fourth step of calculating a displacement between 
a position of said work object and said reference 
position when it is sensed that said movable mem- 
ber contacts with said work object, 
characterized by further comprising: 
a fifth step of applying acceleration to said movable 
member in a direction opposite to a moving direc- 
tion of said movable member in said second step 
when it is sensed that said movable member con- 
tacts with said work object. 

7. A method according to Claim 6. character- 
ized in that said first step further comprises a step 
of teaching said control unit at least one position of 
said work object as a working position, and said 
method further comprises a step of correcting a 
position of said movable member stored in said 
control unit by said displacement 

8. An apparatus for controlling a position of a 



movable member, comprising: 
a movable member (9); 

driving means (39, 40) for driving said movable 
member (9); and 
5 control means (20. 30) for controlling said driving 
means (39, 40), 

wherein said control means (20, 30) comprises first 
control means (20) for correcting a position of said 
movable member (9) by sensing a position of a 

;o work object (11) with respect to a reference posi- 
tion from contact of said movable member (9) with 
said work object (11). characterized in that said 
control means further comprising: 
second control means (30) for controlling said driv- 

;s ing means (39, 40) such that acceleration is applied 
to said movable member (9) when the contact is 
sensed in a direction opposite to a moving direc- 
tion of said movable member when the contact is 
sensed. 

20 9. An apparatus according to Claim 8. char- 
acterized in that said movable member (9) includes 
a contact segment (90) for sensing the contact with 
said work object (11). 

10. An apparatus according to Claim 9, char- 
ts acterized in that said movable member (9) is a 

hand (150) for supporting a welding torch (9) and 
said contact segment is a welding wire (90) deliv- 
ered from said welding torch (9). 

11. A movable member positioning control ap- 
30 paratus, comprising: 

a movable member (9, 150) which is at least two- 
dimensionally movable by actuators; and 
first control means (20) for sensing a relative posi- 
tion of said movable member to a working position 

3s of a work object by contact of a contact segment of 
said movable member with said working position 
and correcting a position of said movable member, 
characterized by comprising: 
second control means (30) for controlling said ac- 

40 tuators such that force is applied to said movable 
member when the contact is sensed in a direction 
opposite to a moving direction of said movable 
member when the contact is sensed, 
and wherein said second control means (30) is 

46 operated for the predetermined time period when 
the contact is sensed. 

12. An apparatus according to Claim 11, char- 
acterized in that said movable member is a torch 
(9) of an electric arc welder, said contact segment 

so is a welding wire (90) delivered from said torch, 
and the contact of said welding wire with said 
working position is sensed by establishment of a 
conductive path between said welding wire and 
said working position. 

55 13. An apparatus according to Claim 11, char- 
acterized in that said second control means in- 
cludes means for controlling a speed of said mov- 
able member when the contact is sensed such that 
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the speed of said movable member is a predeter- 
mined speed. 
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